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I . INTRODUCTION 


A computer  vision  system  has  been  developed  at  the  Coordinated  Science 
Laboratory  (CSL)  which  enables  a PDP-10  computer  to  acquire  television 
pictures  in  diqital  form.  The  television  camera  is  mounted  on  a platform 
referred  to  as  the  pan-tilt  assembly  (see  Fig.  1)  which  can  be  rotated  back 
and  forth  and  tilted  up  and  down  [Geschke,  1975]  . Also  on  the  pan-tilt 
assembly  are  a remote  controlled  zoom  lens  [Williamson,  1975]  and  a range 
finder.  Everything  on  the  Dan-tilt  assembly  except  for  the  camera  is 
interfaced  bo  a PDP-11/40  minicomputer  which  can  communicate  with  the  PDP-10. 

The  device  that  was  most  recently  added  to  the  vision  system  is  the 
range  finder.  By  projecting  a stripe  of  light  onto  the  scene  being  viewed  by 
the  camera,  distances  to  the  points  illuminated  by  the  stripe  can  be  computed 
by  triangulation.  The  source  of  light  is  a 15  milliwatt  helium-neon  laser, 
and  the  laser  beam  is  converted  into  a stripe  and  projected  by  a specially 
built  scanning  head.  This  part  of  the  range  finder  is  patterned  after  a 
similar  range  finder  used  at  Stanford  [Agin  and  Binford,  1973];  however,  the 
CSL  version  is  mounted  differently.  Instead  of  being  attached  to  a table,  the 
laser  and  scanning  head  are  mounted  on  the  pan-tilt  assembly  with  the  camera 
so  that  the  range  finding  facility  is  always  available  no  matter  where  the 
canera  is  aimed.  Furthermore,  this  arrangement  reduces  the  need  for  frequent 


The  scanning  head  consists  of  two  main  parts,  a lens  rotating  assembly 
and  a mirror  assembly  mounted  on  a common  chassis.  A schematic  view  of  the 
scanning  head  is  shown  in  Fig.  2.  The  laser  beam  encounters  the  lens  assembly 
first.  In  the  shape  of  a semicircular  cylinder,  the  lens  causes  the  laser 
beam  to  spread  out  in  only  one  dimension.  This  creates  a plane  of  light  , or 
a stripe  as  seen  by  the  camera.  The  orientation  of  the  plane  is  controlled  by 
the  rotation  of  the  lens  about  the  axis  of  the  laser  beam.  Before  the  olane 
of  light  becomes  too  wide,  it  is  reflected  by  a small  mirror  towards  the  area 
being  viewed  by  the  camera.  Hence,  the  distance  to  virtually  any  point  in  the 
camera's  image  can  be  obtained. 


Laser 
Beam 

Cylindrical  Lens 

FP—  4463 


Fig.  2.  Schematic  of  the  scanning  head. 
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Of  course,  in  order  to  accurately  measure  distances,  the  orientation  and 
scanninq  angle  of  the  plane  of  light  must  be  known  very  precisely. 
Consequently,  the  lens  and  mirror  are  driven  by  stepper  motors  which  are 
controlled  by  the  PDP-11.  The  motors  are  geared  down  so  that  the  lens  moves 
in  angular  increments  of  five  degrees  and  the  mirror  in  increments  of  0.05 
degrees.  (Note,  however,  that  the  net  increment  in  the  scanning  angle  is  one 
tenth  of  a degree.) 

Control  of  the  scanning  head  by  the  PDP-11  is  simplified  by  some  logic 
circuitry  at  the  interface.  Both  the  lens  and  the  mirror  have  a pair  of 
position  registers,  one  for  the  actual  position  and  one  for  the  desired 
position.  The  computer  need  only  load  the  desired  positions  and  the  hardware 
controls  the  motors  automatically.  When  the  motors,  i.e.,  the  lens  and 
mirror,  have  reached  their  desired  positions,  the  hardware  can  signal  an 
interrupt  to  the  computer. 
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II.  PRINCIPLES  OF  OPERATION 


The  basic  method  used  to  determine  the  range  of  an  object  is 
triangulation.  The  scanning  head  projects  a plane  of  laser  light  which  can  be 
seen  as  a stripe  in  the  camera's  image,  while  each  point  in  the  image 
corresponds  to  a ray  in  space  along  which  the  observed  point  must  actually 
lie.  This  ray  intersects  the  plane  in  a unique  point.  If  the  equations  of 
the  ray  and  the  plane  are  known  in  a suitable  coordinate  system,  then  the 
coordinates  of  the  intersection  point  can  be  computed. 

Since  the  camera  and  the  scanning  head  are  both  rigidly  affixed  to  the 
Dan-tilt  platform,  it  is  convenient  to  use  a coordinate  system  also  attache* 
to  this  platform.  Such  a system  is  shown  in  Fig.  3.  In  order  to  simplify  the 
subseauent  analysis,  the  following  assumptions  will  be  made.  (1)  The  axis 
about  which  the  scanning  mirror  rotates  shall  be  parallel  to  the  z axis,  and 
the  surface  of  the  mirror  shall  contain  this  axis  of  rotation.  (2)  The  axis 
of  the  laser  beam  shall  lie  in  the  x-y  plane  and  intersect  the  mirror's  axis 
of  rotation.  (3)  The  cylindrical  lens  shall  be  adjusted  so  that  the  plane  of 
light  rotates  about  the  axis  of  the  laser  beam. 

When  the  above  assumptions  are  satisfied,  the  orientation  and  scanning 
angle  of  the  projected  plane  of  light  can  be  measured  by  the  angles  9 and  <D 
as  shown  in  Fig.  4.  Both  angles  are  shown  with  a positive  d isplacement . 
Hence,  the  direction  angles  of  the  plane  are  given  by 


cos  a = --co-  ^ cos  <D  _ cos  Q cos  (j) 
b 


Fig.  3.  The  range  finder  coordinate  system. 


z 


Fig.  4.  Diagram  of  the  projected  plane  of  light. 
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cop  p = — co-  9 co-  Q = sin  9 cos  0 
p b cot  0 

cos  r = cos (90 P-  0)  = sin  0, 

and  since  the  distance  from,  this  plane  to  the  origin  is  b cos  9 cos  0,  the 
equation  of  the  plane  is  given  by 

x cos  9 cos  (J)  + y sin  9 cos  0 + z sin  0 - b cos  9 cos  0=0.  (1) 

Since  a ray  extended  from  any  point  in  the  camera's  image  passes  through 
an  imaginary  focal  point  located  at  (0,f,0)  on  the  v axis,  it  is  convenient  to 
express  these  rays  in  terms  of  a primed  coordinate  system  centered  at  this 
point  as  shown  in  Fig.  5.  Hence,  we  must  first  express  the  above  plane  in 
terms  of  the  primed  coordinates.  From  analytic  geometry,  the  distance  from 
the  point  (0,f,0)  to  the  plane  in  the  unprimed  coordinate  system  is  given  by 
letting  x = 0,  y = f,  and  z = 0 in  the  left  side  of  Ea.  (1) . Since  this 
distance  simplifies  to  (f  sin  0 - b cos  0)cos  0 and  since  the  direction 
angles  are  unchanged  in  the  crimed  coordinate  system,  the  new  equation  for  the 
Plane  of  light  is  given  by 

x 'cos  0 cos  0 + y'sin  9 cos  (J)  + z'sin  0 

+ (f  sin  9 - b cos  9) cos  0=0.  (2) 

I 

The  points  in  the  camera's  image  can  be  imagined  to  lie  on  a front  image 
plane  with  its  points  designated  by  the  coordinates  u and  v.  However,  the 
location  of  this  image  plane  is  ambiguous;  if  it  is  close  to  the  focal  point, 
a small  image  is  obtained,  and  if  it  is  far  away,  a large  image  is  obtained. 

To  get  around  this  problem,  we  can  access  points  in  the  image  plane  by  angular 
displacements  from  the  y axis;  hence,  we  define  m and  v as  follows; 

P^f*  tan  v = pTf. 


i 


tan  u 


A point  (q,v)  in  the  image,  then,  corresponds  to  a line  in  space  given  by  the 
parametric  eauation  (in  the  parameter  y') 


x ' = y 'tan  ju  , z ' = y 'tan  y . (3) 

The  intersection  of  this  line  and  the  plane  defined  above  can  be  found 
by  substituting  x'  and  z'  from  Eq.  (3)  into  Eq.  (2).  Hence,  we  have 

y'tan  ^ cos  9 cos  0 + y'sin  9 cos  0 + z'tan  y sin  0 

+ (f  sin  9 - b cos  9) cos  0=0, 
or 

- _ b cos  9 - f sin  9 

tan  fj  cos  9 + sin  9 + tan  y tan  0* 

The  x'  and  z'  coordinates  can  be  easily  found  from  Eq.  (3).  In  the  unprimed 
coordinates,  the  values  are  the  same  except  that  y = y'+  f. 

z 

y Sy' 


FP-5216 


Fig.  5.  The  image  coordinate  system. 
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III.  THE  SCANNING  HEAD 

The  function  of  the  scanning  head  is  to  convert  the  laser  beam  into  a 
stripe  and  to  aim  the  stripe  toward  the  area  being  viewed  by  the  camera.  As 
shown  above  in  Fig.  2,  this  is  achieved  with  a cylindrical  lens  and  a scanning 
mirror.  The  actual  scanning  head  is  shown  in  Fig.  6.  The  laser  beam  enters 
on  the  right  through  a hollow  shaft  on  the  lens  rotating  assembly  (the  unit 
assembled  on  the  U-shaped  bracket) . At  the  end  of  this  shaft  is  the  lens 
mounting  assembly  with  the  cylindrical  lens  located  at  the  very  tip.  Then  at 
the  left  is  the  scanning  mirror,  and  the  motors  which  drive  the  mirror  and 
lens  are  in  the  background. 

Frcm  a design  point  of  view,  accomodating  the  assumptions  made  in  the 
above  mathematical  treatment  was  a trivial  problem.  The  following  constraints 
were  imposed  upon  the  design:  the  axis  of  the  hollow  shaft  was  to  intersect 

and  be  perpendicular  to  the  scanning  mirror's  axis  of  rotation;  the  flat  side 
of  the  cylindrical  lens  was  to  be  perpendicular  and  centered  with  respect  to 
the  incident  laser  beam;  and  the  surface  of  the  scanning  mirror  was  to 
contain  the  axis  about  which  it  rotates.  In  order  to  satisfy  these 

constraints  to  the  necessary  degree  of  precision,  the  assemblies  were  designed 
to  be  adjustable  wherever  possible.  Detailed  views  of  these  assemblies  are 
given  in  Appendix  A,  and  the  procedure  for  making  the  adjustments  is  given  in 
Appendix  B. 

In  addition  to  those  constraints  which  simplified  the  mathematical 
analysis,  there  were  other  design  considerations.  One  very  small  detail  was 
the  way  the  laser  beam  should  pass  through  the  cylindrical  lens  to  produce  as 
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long  a stripe  as  possible;  should  it  enter  the  flat  side  or  the  round  side? 
The  path  followed  by  a ray  of  light  in  each  case  is  depicted  in  Fig.  7.  (Jsinq 

Snell's  law  from  optics  and  lettinq  n be  the  index  of  refraction  for  the 

cylindrical  lens,  we  have 

sin  9f  = sin  (nVl  - sin2©^  - VI  - n2sin29£) 

and 

sin  ©r  = sin  9^  ( Vn2  - sin2©^  -Vl  - sin29p  . 

These  deflection  angles  for  liqht  entering  the  flat  and  round  sides 

respectively  are  plotted  versus  sin  ©^  in  Fig.  8.  (The  reason  sin  ©^  is 

used  as  the  independent  variable  instead  of  ©^  is  that  it  is  proportional  to 
the  distance  by  which  an  incident  ray  of  light  is  off  from  the  center  of  the 
lens.)  Since  the  width  of  the  laser  beam  is  quite  a bit  less  than  the  width 
of  the  lens,  it  can  be  seen  that  slightly  greater  angles  of  deflection  are 
obtained  for  light  entering  the  flat  side. 


As  the  light  rays  emerginq  from  the  cylindrical  lens  diverge,  it  is 
conceivable  that  some  of  these  rays  might  completely  miss  the  scanning  mirror. 
Clear lv,  this  problem  is  most  prevalent  when  the  mirror  is  turned  as 
illustrated  in  Fiq . 9a.  Similarly,  when  the  mirror  is  turned  so  that  it  is 
more  nearly  facinq  the  lens  as  shown  in  Fig.  9b,  the  lens  and  its  mounting 
assembly  mav  intercept  some  of  the  liqht  reflected  by  the  mirror  thus  casting 
a shadow.  In  either  case,  there  is  a possiblity  that  blind  spots  may  be 
produced  in  the  range  finder.  Hence,  an  additional  design  consideration  was 
to  minimize  these  effects  and  to  make  sure  that  the  entire  field  of  view  for 
the  camera  could  be  illuminated  by  the  range  finder.  (It  should  be  pointed 
out  that  blind  soots  can  be  produced  by  yet  a third  phenomenon  over  which 
there  is  no  control.  Since  the  scanning  head  must  be  displaced  from  the 
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Fig.  7.  The  paths  taken  by  a ray  of  light  through  the  cylindrical 
lens  when  light  enters  the  flat  side  (left)  and  the  round  side  (right) . 
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Fig.  8.  Deflection  angles  plotted  versus  sin  0^  where  the 
index  of  refraction  (n)  is  assumed  to  be  1.5. 


13 


optical  axis  of  the  camera,  the  projected  stripe  can  fall  on  surfaces  which 
cannot  be  seen  from  where  the  camera  is  located.) 


Mirror 


Mirror 


.Loser 

Beam 


(a)  Light  Missing  the  Mirror 


Laser 

Beam 


(b)  Light  Intercepted  by  the  Lens 


Fiq . 9.  Effects  producing  blind  soots  in  the  range  finder. 


Several  factors  were  considered  which  might  alleviate  the  problem  of 
blind  spots.  One  was  the  distance  of  the  lens  mounting  assembly  from  the 
mirror.  When  the  lens  is  moved  closer  to  the  mirror,  less  light  misses  the 
mirror,  but  at  the  same  time,  the  problem  of  shadows  becomes  worse.  Two  other 
factors  considered  were  the  dimensions  of  the  lens  mounting  assembly  and  tne 
possiblily  of  mounting  the  whole  scanning  head  at  an  angle  slightly  facing  the 
optical  axis  of  the  camera.  By  far  the  most  promising  consideration,  however, 
was  the  idea  of  mounting  the  scanning  mirror  so  that  it  would  rotate  about  a 
line  offset  from  the  center  of  the  mirror  as  shown  in  Fig.  10.  Not  only  does 
this  result  in  the  side  of  the  mirror  farther  from  the  lens  to  subtend  an 
angle  from  the  lens  more  nearly  eaual  to  the  angle  subtended  by  the  near  side, 
but  it  also  allows  the  lens  to  be  moved  closer  to  the  mirror  without  danger  of 
the  mirror  colliding  with  the  lens  when  it  turns  fully  clockwise. 
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Fig.  10.  Rotating  the  mirror 
about  a line  offset  from  the  center 
of  the  mirror. 

Of  these  considerations,  only  the  first  could  be  adjusted  after  the 
construction  and  mounting  of  the  scanning  head  (since  the  lens  mounting 
assembly  can  be  slid  back  and  forth  on  the  hollow  shaft) . The  other 
considerations,  however,  had  a direct  effect  on  the  design  of  the  scanning 
head.  Hence,  some  method  for  determining  when  the  design  minimized  the 
occurrence  of  blind  spots  had  to  be  devised.  An  attempt  was  made  to  solve  the 
problem  analytically,  but  the  analysis  became  too  difficult.  Consequently,  a 
computer  program  was  written  to  simulate  a model  of  the  scanning  head.  Given 
the  parameters  described  above  and  the  orientation  of  the  cylindrical  lens, 
the  program  would  scan  the  stripe  across  the  entire  field  of  view  in 
increments  of  ten  degrees.  The  output  of  the  program  was  the  set  of  endpoints 
of  all  stripes  and  shadows  cast  upon  a rectangular  sheet  of  specified  size  and 
distance  from  the  camera.  Fig.  11  shows  a typical  output  of  the  program 
illustrated  graphically.  By  trial  and  error,  it  was  found  that  the  use  of 
mirror  offset  alone  was  sufficient  to  shift  all  blind  spots  to  well  outside 
the  camera's  normal  field  of  view. 


FP-S217 

Fig . 11.  Simulated  scan  of  the  range  finder  across  a rectangular 
sheet  (rectangular  sheet:  3 m.  by  6 m.  in  size,  2 m.  from  camera; 
baseline  = 70  cm.;  mirror  offset  = 1 cm.;  0 = 45  degrees). 

We  turn  now  to  the  means  by  which  the  mirror  and  lens  are  rotated.  As 
pointed  out  above,  the  positions  of  the  mirror  and  lens  must  be  known  with 
fairly  high  accuracy,  so  it  was  decided  to  drive  them  with  stepper  motors. 
Since  fine  adjustment  of  the  lens  rotation  was  not  deemed  critical,  a motor 
with  24  steps  per  revolution  and  a single  pair  of  gears  with  a 3:1  turning 
ratio  was  chosen  to  drive  the  lens.  This  provides  a rotation  in  increments  of 
five  degrees,  and  it  allows  orthoqonal  stripes  to  be  produced,  e.g.,  at  -45 
and  +45  degrees.  Fine  adjustment  of  the  mirror's  position,  on  the  other  hand, 
was  considered  more  critical  or  else  small  objects  in  the  camera's  image  might 
get  skipped  by  the  stripe  as  it  scans  back  and  forth.  In  other  words,  it  was 
desired  that  the  stripe  move  in  increments  not  much  larger  than  the  width  of 
the  stripe.  Hence,  a motor  with  200  steps  per  revolution  was  selected,  and  in 
order  to  reduce  the  increments  in  the  scanning  angle  down  to  the  required 
amount,  i.e.,  one  tenth  of  a deqree,  a gear  reduction  of  36  was  required.  The 
arrangement  of  the  motors  and  gears  is  shown  in  Appendix  A. 
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IV.  THE  RANGE  FINDER  ELECTRONICS 

The  electronic  hardware  which  controls  the  range  finder  is  distributed 
in  three  locations,  but  most  of  it  is  concentrated  in  the  PDP-11  backplane.  A 
block  diagram  of  how  it  is  distributed  and  the  main  paths  of  information  flow 
are  illustrated  in  Fig.  12.  Although  it  is  not  shown,  every  block  except  for 
the  control  and  status  block  consists  of  two  virtually  identical  halves 
corresponding  to  the  mirror  and  lens. 

Since  the  motor  controllers  play  such  a central  role,  they  should  be 
described  first.  The  schematic  for  a controller  is  shown  in  two  parts  in 
Fiqs.  13  and  14.  In  essence,  the  controller  has  two  inputs  and  two  outputs. 
One  input  is  to  drive  the  motor  clockwise  by  producing  a train  of  pulses  on 
the  clockwise  output,  and  the  other  input  and  output  drive  the  motor  counter- 
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Fig.  12.  Block  diagram  of  the  range 
finder  electronics. 
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Fig.  14.  Step  generating  circuitry  of  the  motor  controller 
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clockwise.  Each  pulse  on  the  output  causes  the  motor  driver  to  step  the  motor 
one  position  in  the  appropriate  direction.  An  additional  pair  of  inputs 
corresDond  to  CW  and  CCW  limit  switches,  although  these  inputs  are  not  used  on 
the  lens  controller.  When  the  mirror  moves  so  far  as  to  trip  one  of  these 
limit  switches,  the  output  pulses  which  have  been  driving  the  mirror  in  that 
direction  are  automatically  stopped. 

These  very  basic  features  of  the  motor  controller  are  embodied  in  the 
circuitry  shown  in  Fig.  14.  The  CW  and  CCW  direction  inputs  (which  connect  to 
Fig.  13)  are  normally  low  logic  levels;  when  one  of  these  lines  goes  high,  a 
seauence  of  pulses  at  the  corresponding  output  is  produced.  If  the  other 
input  should  also  go  hiqh,  it  is  prevented  from  having  any  effect  by  the  pair 
of  cross  coupled  HAND  gates  7-2  and  7-3.  These  same  two  NAND  gates  are  used 
to  stop  the  pulses  when  a limit  switch  is  activated.  The  limit  switch  inputs 
are  normally  high,  so  when  one  of  them  goes  low,  the  direction  input  which 
goes  through  the  same  NAND  gate  is  inhibited. 

The  controller  is  fairly  immune  to  noise  on  the  input  lines  by  virtue  of 
the  latches  8-1  and  8-2  and  the  monostable  multivibrator  11-1.  The  latter  is 
triggered  when  either  direction  input  goes  high  for  the  first  time  after  a 
relatively  long  pause,  and  on  the  falling  edge  of  the  pulse  produced  by 
monostable  11-1,  the  the  complements  of  the  direction  inputs  are  latched.  If 
the  signal  which  caused  the  triggering  was  only  a spurious  noise  pulse,  then 
it  will  have  likely  gone  away  by  the  time  the  signal  is  latched  (about  a 
microsecond  later),  and  a spurious  step  to  the  motor  driver  will  not  occur. 
Furthermore,  the  latches  are  only  reloaded  just  before  each  new  step  in  a 
seauence  of  pulses  is  to  be  generated.  Hence,  any  noise  occurring  on  the 
input  lines  during  the  meantime  will  have  no  effect. 
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It  is  the  signal  that  is  latched  just  before  a step  pulse  is  to  be 
generated  that  determines  which  output  will  produce  the  pulse,  if  either  is  at 
all.  If  one  of  the  direction  inputs  was  high  at  the  time  of  the  latching, 
then  the  corresponding  outputs  are  enabled  via  the  NOR  gates  9-1  and  9-4.  If 
neither  direction  input  was  high,  then  no  step  is  produced.  In  this  event, 
the  output  of  NOR  gate  9-3  goes  high  thus  (1)  clearina  the  step-producing 
monostable  10-2  before  it  is  triggered  by  the  output  of  monostable  10-1,  (2) 
re-enabling  monostable  11-1  to  be  triggered  by  an  initial  input  signal,  and 
(3)  clearing  the  output  line  labelled  BUSY.  The  BUSY  line  only  goes  high  when 
step  signals  are  being  generated.  Also  note  that  the  step  signal  outputs  are 
duplicated.  Che  set  aoes  to  the  motor  driver,  while  the  other  set  goes  to  the 
position  register  to  increment  or  decrement  the  position  counter. 

We  now  turn  to  the  other  half  of  the  motor  controller  (Fig.  ]3). 
Working  backwards  from  the  lines  connecting  to  the  step  generation  circuit 
just  described,  we  find  IC-6  which  selects  between  two  sets  of  inputs.  The 
lower  sec  of  inputs  (B)  are  from  the  manual  controller  , and  the  upper  set  (A) 
are  for  automatic  control.  Since  this  selector  is  controlled  by  the 
AUTO/MANUAL  line  from  the  manual  control  panel,  all  automatic  control  is 
inhibited  whenever  the  range  finder  is  put  in  manual  mode. 

Next  we  find  that  the  inputs  corresponding  to  automatic  control  come 
from  the  output  of  yet  another  two-way  selector,  IC-5.  This  time,  the  signal 
which  controls  the  selector  is  the  INITIALIZE  input.  This  inout  causes  the 
motor  to  seek  its  home  position  which  is  sensed  by  an  optical  switch  on  the 
scanning  head.  Conseouently,  a special  set  of  direction  commands  need  to  be 
generated  during  the  initialization  process,  and  the  purpose  of  IC-5  is  to 
switch  from  the  normal  direction  inputs  over  to  a circuit  which  seeks  home. 
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The  home-seeking  circuit  works  as  follows.  The  cross  coupled  NOR  gates 
4-2  and  4-3  initially  drive  the  CCW  direction  line.  If  at  any  time  the  HOME 
INDICATOR  input  goes  low,  then  both  NOR  gates  are  turned  off  thus  stopping  the 
CCW  drive  signal.  However,  if  the  home  position  was  not  found,  then  the  CCW 
limit  switch  will  be  activated,  and  this  causes  the  state  of  the  two  NOR  gates 
to  chanae  so  that  the  motor  starts  moving  in  a CW  direction.  As  before,  as 
soon  as  the  home  position  is  reached,  the  motor  will  stop.  If  the  home 
position  is  not  found,  then  the  motor  will  stop  when  it  reaches  the  CW  limit 
switch  and  remain  there. 

As  can  be  seen,  the  status  of  all  the  switches  are  made  available  as 
outputs  on  the  controller.  In  fact,  very  nearly  all  of  the  lines  terminating 
at  the  top  of  Fig.  13  can  be  read  or  written  by  the  PDP-11  via  the  control  and 
status  register  (CSR)  of  the  range  finder.  Whenever  the  PDP-11  loads  the  CSR 
with  new  data,  a pulse  on  the  the  WRITE  CSR  line  is  generated  causing  the 
INITIALIZE  and  GO  bits  to  be  latched  into  IC-3.  These  latches  are  necessary 
to  keep  the  range  finder  from  moving  around  randomly  when  the  power  to  the 
backplane  is  turned  on;  the  bits  in  the  CSR  would  initially  be  random,  but 
the  latches  act  as  a buffer  and  are  cleared  by  the  action  of  gate  2-4.  These 
latches  are  also  cleared  whenever  the  PDP-11  issues  a UNIBUS  reset. 

We  can  now  consider  some  of  the  other  blocks  which  are  connected  to  the 
motor  controllers.  The  motor  drivers  and  the  scanning  head  need  hardly  be 
mentioned.  The  motor  drivers  were  purchased  along  with  the  motors,  and  all 
they  do  is  take  the  pulses  coming  in  on  CW  and  CCW  inputs  and  energize  the 
appropriate  windings  in  the  stepper  motors.  The  scanning  head  merely  contains 
a collection  of  switches  and  optical  encoders  whose  effects  have  been 


discussed  above. 
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Returning  to  the  backplane,  we  have  the  position  registers.  These  are 
closeslv  related  to  the  rotor  controllers  in  that  they  close  an  open  loop 
inherent  in  the  controllers.  A block  diaqram  of  a position  register  is  given 
in  Fiq . 15.  Note  that  there  are  actually  two  registers  in  the  circuit,  a 
write-register  and  a read-reoister  wnich  can  be  written  and  read, 
respectively,  bv  the  PDP-11.  The  read-register  is  a binary  counter  where 
CQUVr  UP  and  COUNT  DOWN  inputs  are  connected  to  (duplicates  of)  the  rotor 
driver  outputs  on  the  rotor  controller.  Hence,  the  read-register  is 

incremented  or  decremented  as  the  motor  is  stepped  one  position  CW  or  CCW 
respectively.  The  PDP-11  can  load  the  position  it  would  like  the  motor  to  go 
to  into  the  writer  eg  ister . The  contents  of  the  read  and  write-registers  are 
compared,  and  the  result  is  made  available  on  two  output  lines  (a  third  output 
is  not  used)  . These  outputs  are  wired  to  the  direction  inputs  on  the  motor 
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controller  so  that  when  the  contents  of  the  two  reqisters  are  unequal,  the 
| motor  is  driven  in  such  a direction  as  to  lessen  the  difference.  When  the 

difference  is  reduced  to  zero,  the  motor  stops.  Finally,  the  contents  of  the 
• read-reaister  are  initialized  bv  aoolvinq  a LOAD  siqnal.  This  sional  is  wired 

, to  coincide  with  the  INITIALIZE  sional  applied  to  the  motor  controller,  and 

the  effect  is  to  load  the  contents  of  the  write-register  into  the 
read-reaister  while  inhibitinq  counting.  Hence,  while  the  motor  is  seekina 
its  home  oosition,  the  PDP-11  can  load  the  oosition  register  with  the  value  it 
would  like  the  home  oosition  to  correspond  to. 


The  control  and  status  circuitrv  consists  mainly  of  a 16-bit  reaister 
which  interfaces  to  the  PDP-11.  The  assignments  of  the  various  bits  in  the 
CSR  are  given  in  Table  1;  most  are  self  explanatory.  The  numberinq  of  the 
bits  follows  the  DEC  convention  [Digital  Equipment  Corporation,  1973] . There 
is  a small  amount  of  logic  circuitrv  used  in  conjunction  with  the  CSR.  Sit  15 
is  the  logical  OR  of  bits  13  and  14,  i.e.,  whenever  a limit  switch  is 
activated,  the  error  bit  is  set.  Since  it  is  a standard  DEC  procedure  to  use 
bit  7 for  the  done  bit  and  since  there  are  both  a mirror  and  a lens  which 
produce  independent  done  bits,  a means  for  selecting  between  the  two  was 
needed.  Bits  4 and  5 we re  used  for  this  purpose.  When  onlv  bit  4 is  set,  the 
mirror  done  bit  is  selected,  and  when  only  bit  5 is  set,  the  lens  done  bit  is 
selected.  When  both  bits  are  set,  then  the  loqical  AND  of  the  two  done  bits 
is  used. 

The  done  bit  is  also  used  to  request  an  interrupt  on  the  PDP-11.  This 
is  accomplished  bv  means  of  an  interrupt  card  which  is  also  included  within 


the  control  and  status  block  of  Fia.  12.  The  interrupt  card  reouires  only  two 
inputs,  an  interrupt  reouest  and  an  interrupt  enable.  An  interrupt  is 


Write  Onlv  Bits 


Bit  0 
3it  1 
Bit  2 
Bit  3 

Bits  4 

Bit  6 
Read  Only 
Bit  7 
Bit  8 

Bit  9 
Bit  10 
Bit  11 
Bit  12 
Bit  13 
Bit  14 
Bit  15 


Go 

Initialize  mirror 
Initialize  lens 

Reserved  for  future  imolementation  of  a shutter 
at  the  aperture  of  the  laser 

& 5 Used  to  select  which  done  bit  is  displayed 
(see  text) 

Interrupt  enable 

Bits 

Done  bit 

Reserved  for  future  implementation  of  a shutter 
at  the  aperture  of  the  laser 

Not  used 

Manual  indicator 

Home  indicator  for  lens 

Home  indicator  for  mirror 

Status  of  CCW  limit  switch  on  mirror 

Status  of  CW  limit  switch  on  mirror 

Error 


Table  1.  Ihe  bits  of  the  control  and  status  register 
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produced  when  the  former  makes  a transition  from  low  to  high  while  the  latter 
is  set  high.  Clearly,  the  done  bit  is  connected  to  the  interrupt  reouest 
inout,  and  the  interrunt  enable  input  is  taken  from  the  same  sianal  on  the 
CHR.  It  should  be  noted  that  the  done  bit  goes  high  whenever  the  range  finder 
stops  after  bavina  been  set  in  motion.  Hence,  an  interrunt  can  be  generated 
after  initializing  the  range  finder  as  well  as  .after  completing  normal 
commands  to  move  about. 

Finally,  the  manual  controller  deserves  a brief  mention.  Its  basic 
function  is  to  allow  manual  positioning  of  the'  projected  laser  stripe.  For 
convenience,  this  is  implemented  with  a jovstick  where  the  left-riqht  axis 
controls  the  scanning  angle,  and  the  uo-down  axis  controls  the  orientation  of 
the  stripe.  The  manual  controller 's  outputs  which  go  to  the  motor  controllers 
provide  a variable  rate  seouence  of  pulses,  the  rate  being  controlled  bv  the 
joystick.  So  long  as  each  pulse  is  narrower  than  the  stepping  rates  actually 
aoolied  to  the  motor  drivers,  the  motor  controllers  can  be  operated  in  the 
mode  where  one  pulse  in  produces  one  motor  step  on  the  output.  There  is  also 
a switch  for  manually  interrupting  the  computer.  This  makes  it  possible  for  a 
program  to  reouest  a human  operator  to  position  the  strioe  and  to  allow  the 
operator  to  signal  completion  just  as  if  the  motors  had  been  contolled  in  the 


automatic  mode 
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V.  CONCLUSION 

Although  the  range  finder  electronics  described  above  seems  to  have  no 
flaws,  there  are  several  aspects  of  the  scanninq  head  that  are  worthy  of 
improvement.  To  anyone  witnessina  the  ranae  finder  in  operation,  the  most 
obvious  of  these  is  the  noise  made  by  the  gear  reduction  assemblies  when  being 
driven  bv  the  stepper  motors.  Since  the  mirror  has  a finite  range  of  motion, 
it  was  possible  to  reduce  the  noise  in  the  mirror  assembly  somewhat  by  taking 
up  the  backlash  in  the  clears  with  a spring.  However,  the  same  could  not  be 
done  for  the  lens  assembly  because  it  can  rotate  all  the  way  around.  It  has 
been  noticed  that  frictional  damning  applied  to  the  shafts  of  either  motor 
tends  to  reduce  the  noise  somewhat,  but  since  it  is  not  critical  for  reliable 
operation  of  the  range  finder,  no  permanent  damping  has  been  installed. 

The  second  problem  involves  the  response  of  the  stepper  motors.  In 
order  for  the  position  registers  to  maintain  an  accurate  record  of  the 
position  of  the  mirror  and  lens,  the  motors  must  respond  to  every  step  command 
they  receive.  If  the  motors  are  driven  too  fast,  they  will  lose  their 
position.  It  is  desirable  to  drive  the  mirror  motor  nearly  as  fast  as 

possible  since  it  takes  over  1000  steps  to  get  from  one  end  of  its  range  to 

the  other  (although  the  range  within  the  camera's  field  of  view  is  normally 
much  less).  By  trial  and  error,  the  maximum  rate  was  found  to  be  about  60 
steps  per  second.  The  lens,  on  the  other  hand,  need  not  be  driven  so  fast 
since  it  rotates  in  such  large  angular  increments.  A safe  and  convenient 

speed  for  the  lens  motor  appears  to  be  about  15  steps  per  second. 
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The  noise  and  response  of  the  scanning  head  motors  could  probably  be 
improved  by  using  small  D.C.  toroue  motors  instead  of  stepper  motors. 
However,  in  order  to  move  the  motors  to  SDecific  positions,  additional  wires 
carrying  positional  feedback  would  be  required,  and  in  order  to  obtain 
sufficient  accuracy,  digital  quadrature  encoders  would  have  to  be  used  on  the 
shaft  of  each  motor.  For  the  improved  performance,  this  added  complexity 
might  be  worthwhile,  but  the  stepper  motors  are  certainly  adequate  when  slow 
speeds  and  noise  can  be  tolerated. 

Finally,  there  are  several  problems  regardinq  the  quality  of  the  laser 
stripe  produced  by  the  cylindrical  lens.  The  least  serious  of  these  is  the 
wav  the  intensity  of  the  light  varies  along  the  length  of  the  stripe;  it  is 

much  brighter  near  the  center  than  at  the  ends.  There  are  three  or  four 
factors  which  contribute  to  this  effect,  but  since  the  distances  and 
reflectivities  of  various  objects  illuminated  by  the  range  finder  will  be 
subject  to  wide  variations  as  well,  the  software  for  finding  the  stripe  will 
have  to  be  insensitive  to  variations  in  intensity  anyway. 

A sliohtly  more  serious  problem  is  that  the  range  finder  does  not 
currently  produce  a stripe  long  enough  to  span  from  the  top  to  the  bottom  of 
the  widest  ancle  image  produced  bv  the  camera.  (The  camera's  maximum  vertical 
field  of  view  is  about  32  degrees  while  the  stripe  only  subtends  an  angle  of 
about  18  degrees.)  Since  the  laser  beam  is  slightly  diverqent,  the  stripe 
could  be  lengthened  by  increasing  the  length  of  the  optical  path  from  the 
laser  to  the  scanninq  head;  however,  this  might  cause  vibration  of  the  laser 
beam  relative  to  the  scanning  head  to  become  a problem.  A collimator  which 
increases  the  beam  diameter  would  not  have  the  problem  of  vibration,  but  it 
would  make  the  stripe  wider.  Hence,  for  the  time  being,  a short  stripe  will 
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have  to  suffice. 

The  most  serious  problem  with  the  cylindrical  lens  is  that  when  it  is 
aliqned  as  it  ouoht  to  be,  it  produces  many  frinqes  parallel  to  the  main 
stripe.  It  is  believed  that  these  frinqes  are  caused  bv  internal  reflections 
inside  the  lens  interfering  with  the  original  light  ravs.  If  the  lens  is 
tilted  so  that  its  lennthwise  axis  is  about  five  decrees  off  from  being 
perpendicular  to  the  incident  laser  beam,  then  the  frinqes  disaooear.  When 
the  lens  is  tilted  in  this  manner,  it  can  be  shown  that,  the  stripe  will  be 
sliqhtlv  bent  into  a shape  resemblinq  a hyperbola;  althouqh,  in  practice, 
this  bend  is  not  visually  apparent.  Hence,  it  is  hoped  that  the  bend  whicn  is 
theoretically  there  will  not  be  more  significant  than  the  other  sources  of 
error,  such  as  spatial  quantization  error  in  the  diqitized  image  and 
uncertainty  in  the  positions  of  the  mirror  and  lens.  In  anv  event,  the  bend 
in  the  stripe  will  only  affect  the  end  portions  of  tne  strine. 
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APPENDIX  A 

DRAWINGS  OF  THE  SCANNING  HEAD 

In  Fiqs.  16-21,  detailed  views  of  the  scanning  head  and  its  components 
are  given.  In  order  to  keeD  the  drawings  simDle,  most  of  the  dimensions  have 
been  omitted.  However,  the  figures  are  drawn  to  scale,  so  approximate 
dimensions  can  be  obtained  by  direct  measurement.  Note  that  in  the  isometric 
drawings,  the  dimensions  are  measured  along  the  projected  orthogonal  axes 
(soaced  at  120  degree  intervals)  which  therefore  causes  the  objects  thus  j 

rendered  to  appear  larger  than  their  actual  sizes. 
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Fia.  17.  Reduction  qear  asseifblv  underneath  the  main  chassis 
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APPENDIX  B 


ALIGNMENT  OF  THE  SCANNING  HEAD 

Altogether,  there  are  seven  components  reouirinq  alignment.  These 
include  two  small  mirrors  which  deliver  the  laser  beam  to  the  scanning  head, 
the  lens  rotatinq  assembly,  the  cylindrical  lens  mounting  assembly,  the 
scanninq  mirror,  and  the  two  optical  switches  which  sense  the  home  positions 
of  the  rotatinq  lens  and  the  scanninq  mirror.  Since  some  of  these  components 
must  be  aliqned  before  others,  and  since  such  alignment  is  fairly  difficult 
without  the  aid  of  some  very  special  alignment  tools,  a detailed  discussion  of 
the  proper  procedure  to  follow  is  given  below. 

First  of  all,  the  home  sensing  apparatus  on  the  mirror  assembly  reauires 
a preliminary  alignment  that  can  only  be  done  with  the  scanning  head  removed 
fran  the  oan-tilt  platform.  Since  the  motor  turns  around  six  times  as  the 
mirror  moves  from  stop  to  stop,  an  additional  limit  switch  on  the  second  gear 
is  wired  in  series  with  the  optical  sensor  on  the  motor.  The  recession  in  the 
face  of  this  second  gear  must  be  aliqned  with  the  switch  when  the  mirror  is 
turned  approximately  45  degrees  fran  the  axis  of  the  incident  laser  beam.  To 
make  this  alignment,  first  position  the  mirror  mounting  assembly  on  the  shaft 
it  rotates  about  so  that  the  total  scanning  range  is  ecrually  distributed  about 
the  45  degree  position.  Then,  turn  the  mirror  fully  clockwise  until  the  gear 
connected  to  the  mirror  becomes  disengaged.  The  rest  of  the  gears  and  the 
motor  can  now  be  turned  freely  without  movina  the  mirror.  After  re-ergaging 
the  gears,  see  if  the  recession  in  the  second  gear  is  properly  aligned,  and  if 


37 


The  next  item  that  should  be  adjusted  is  the  lens  rotating  assembly. 
The  axis  of  the  hollow  shaft  must  he  aimed  so  that  it  intersects  the  axis  that 
the  scanninq  mirror  rotates  about.  This  adjustment  is  best  accomplished  with 
two  soecial  instruments  whicn  extend  these  axes  closer  to  the  point  of  their 
intersection.  Both  of  these  instruments  are  sirndy  rods  with  pointed  ends, 
one  six  to  eiqht  inches  lonq  which  fits  snugly  inside  the  bore  of  the  hollow 
shaft,  and  the  other  about  an  inch  and  a half  in  length  with  a hole  bored  in 
the  center  of  the  non-oointed  end  so  that,  it  fits  snuqly  over  the  shaft  that 
the  scanning  mirror  attaches  to.  Of  course,  the  mirror  and  lens  mountinqs 
need  to  be  ranoved  before  these  rods  can  be  inserted  in  their  respective 
places.  When  this  is  done,  slide  the  lens  rotating  assembly  about  until  the 
points  of  the  two  pointed  rods  can  be  made  to  coincide. 

The  third  item  to  lx?  aligned  is  the  first  delivery  mirror  that  the  laser 
beam  encounters.  It  is  necessary  that  the  laser  beam  intersect  the  second 
mirror  at  precisely  the  same  point  as  does  the  axis  of  the  hollow  shaft  on  the 
lens  rotating  assembly.  Insert  the  long  pointed  rod  through  the  hollow  shaft 
so  that  the  point  almost  touches  the  second  mirror.  Then  adjust  the  two 
alignment  screws  on  the  first  mirror  to  make  the  laser  beam  fall  sauarely  on 
the  point  of  the  rod.  It  should  be  noted  that  when  adjusting  the  mirror  (and 
all  the  other  mirrors  on  the  ranoe  finder  as  well)  , one  screw  moves  the  laser 
beam  up  and  down  while  the  otner  screw  moves  the  beam  right  and  left. 

Alignment  of  the  second  delivery  mirror  is  next.  The  laser  beam  must 
coincide  with  the  axis  of  the  hollow  shaft  on  the  lens  rotating  assembly.  On 
the  end  of  the  shaft  where  the  lens  mounting  assembly  goes,  out  a piece  of 
translucent  tape  with  a quarter  inch  circle  and  crosshairs  drawn  on  it.  The 
circle  should  correspond  to  the  bote  of  the  shaft,  but  to  verify  that  the 
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crosshairs  are  orooerly  centered,  spin  the  shaft  to  see  if  the  center  of  the 
crosshairs  remains  stationary.  Then  adjust  the  second  mirror  until  the  laser 
beam  is  centered  in  the  crosshairs. 

Now  that  the  incident  laser  beam  is  correctly  oositioned,  the  lens 
rotating  assembly  reouires  several  more  adjustments.  Turn  the  gear  on  the 
shaft  of  the  steeper  motor  so  that  when  the  motor  is  energized,  the  hole  in 
the  laraer  qear  lines  up  with  the  optical  sensor.  Next,  insert  the  lens 
mounting  assembly  on  the  hollow  shaft  so  that  the  projected  stripe  is 
approximately  vertical.  The  adjustment  which  makes  it  exactly  vertical  is  to 
be  made  later.  Now,  slide  the  lens  mountinq  block  uo  or  down  until  the  stripe 
is  centered  about  the  axis  of  the  laser  beam.  Finally,  adjust  the  lens 
attitude  olate  so  that  the  beam  reflected  by  the  flat  side  of  the  lens  is 
parallel  to  the  incident  beam,  and  then  lower  one  end  of  the  lens  until  the 
frinaes  on  either  side  of  the  stripe  go  away. 

Next,  the  scanning  mirror  needs  to  be  adjusted  to  line  the  surface  of 
the  mirror  uo  with  the  axis  of  the  mounting  hole  on  the  mirror  mounting 
assembly.  Insert  this  assembly  onto  its  shaft.  One  half  of  the  end  of  the 
shaft  should  be  visible  in  the  mirror  and  should  appear  to  be  part  of  the 
actual  shaft,  as  if  the  mirror  were  not  really  there.  While  lookina  down  on 
the  end  of  the  shaft,  adjust  the  screw  holding  the  ball  bearino  until  the 
shaft  looks  perfectly  round.  Then,  while  viewing  the  end  of  the  shaft  from  a 
lower  anale,  adjust  the  screw  at  the  top  of  the  mirror  assembly  until  the  top 
of  the  shaft  looks  Perfectly  flat.  Note  that  this  alignment  requires  share 
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To  complete  the  adjustment  of  the  home  position  on  the  mirror,  turn  the 
stripe  so  that  it  is  vertical  and  drive  the  scanning  motor  until  the  light  is 
being  projected  parallel  to  the  optical  axis  of  the  camera.  The  limit  switch 
in  series  with  the  optical  sensor  should  now  be  closed.  Then  turn  the  disc 
which  blocks  the  optical  sensor  so  that  the  slit  in  the  disc  causes  the  output 
of  the  sensor  to  go  low. 


One  final  note:  these  last  two  steps  may  not  align  the  range  finder 

with  the  true  optical  axis  of  the  camera,  but  to  a very  close  aoproximation, 
an  axis  can  be  defined  slightly  off  center  in  the  image  from  which  the  angles 
to  other  points  in  the  image  are  measured. 
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